function delta_Ttool = calculate_delta_Ttool(tx, ty, tz, delta_tx, delta_ty, delta_tz)
delta_Ttool = [0, 0, 0, delta_tx;
    0, 0, 0, delta_ty;
    0, 0, 0, delta_tz;
    0, 0, 0, 0];